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I. INTRODUCTION: 


This report is a follow-up to the interim technical 
report of July 1987 regarding the on-line range prediction 
system for the laser ranger at Crows Landing [1] . The on-line 
range prediction system is designed for providing a 
prediction of the target range in the case of a laser data 
dropout. It consists of real time implementation of a Kalman 
filter on an IBM PC/AT equipped with necessary hardware. The 
system was set up and tested at Crows Landing in the Fall of 
1987. 

This is a report of the improvements made on the on-line 
range prediction system during 1988. It is organized as 
follows. We begin by discussing and proposing solutions to 
the several problems encountered during system tests. Then, 
we explain the improvements made on the filter sotware, 
namely, accounting for the time lag and providing data 
continuously. Finally, we mention the ideas that can be 
considered in the future. 

II. TEST RESULTS: 

During the initial tests at Crows Landing, althoung the 
range output was stable, a jittering in the velocity output 
of the filter was observed. This problem was resolved during 
further tests performed at UCLA in Spring 1988 using an 
identical computer system and additional circuitry provided 
by Fred Shigemoto. The circuitry consisted of a 21 bit serial 
data generator simulating the incoming laser range data, and 
a serial to parallel converter that is also used in the 
original system at Crows Landing. Range and range velocity 



outputs of the system were displayed on a simple digital 
display circuit. 

It was found that the jittering problem was caused by the 
"data ready" signal which was a square wave with period T, 
the sampling period of the filter. Thus, the "on" time of the 
ready pulse was also T seconds. But the sampling period is 
(and must be) longer than the time it takes to process a 
single data sample (2 milliseconds). Hence, when the system 
started checking for the ready pulse immediately after 
outputting the previously processed sample, it found a"high" 
signal even though no new sample had arrived. Consequently, 
the synchronization of the system with the arriving data 
samples was lost and this has resulted in unusal velocity 
estimates, or jittering. 

For best performance, then, the ready signal should be a 
pulse having a width greater than 4 microseconds but less 
then the 2 milliseconds program execution time. Only in this 
case, each "data ready" pulse will correspond to a new 
incoming data sample and the synchronization of the system 
will be maintained. 

III. PROGRAM TERMINATION:. 

The second problem is the termination of the program. At 
present, once it starts running it is not possible to stop 
the Kalman filter program using the keyboard commands except 
by system reset. Automatic stopping of the program occurs 
only when the range input is greater than 50 miles. 

The assembly language routines and the main program are 
updated in a way that will enable normal termination of the 
execution upon request. The method is that an externally 
supplied termination request signal is recognized by the 
software and the program stops running. Bit 21, which is one 



of the unused bits of the 32 bit input data is employed for 
this purpose (see Fig.l). 

A minimal external hardware consisting of a toggle switch 
between 0 and 5 volts is required. Bit 21 is already 
connected to bit 5 of port 2 on the input board (pin 43 on 
the input board connector) . A high value set manually on this 
bit via the switch causes the input subroutine to return a 
special number to the main program which detects it, 
resulting in the program termination. The number sent is 2 21 
(counts) , which corresponds to a range greater than 50 miles 
and since the filter software is already set to stop whenever 
the input range data is greater than 50 miles, this causes 
normal termination of the program. 

Since the input subroutine is periodically called by the 
main program, a stop request is recognized by the upcoming 
subroutine call, hence it is always possible to stop the 
program. When program termination is requested through the 
switch, the data at the input port is ignored. 


TV. TTMF LAfl BETWEEN INPUT AND OUTPUT.!. 

There are two major improvements which have been made on 
the existing Kalman filter. The first one regards the output 
and its corresponding input. Since it takes a finite amount 
of time to process a sample (around 2 milliseconds) , the 
range output corresponds to the input sample that has arrived 
2 milliseconds earlier than the output instant (see Fig. 2) . 

One way of accounting for this time lag is by propagating 
the range estimate using the velocity estimate. That is, at 

the instant nT+A, S n+A is sent out to the port instead of R n 


, where 



and A is the amount of time lag, which is around 2 
milliseconds execution time plus the time it takes to do the 
above calculation. R n and V n are the estimates of range and 
velocity, respectively, calculated by the Kalman filter using 
the input data that has arrived at the instant nT . The main 
program has been updated to do the propagation described. A 
listing can be found in the appendix. 

V. CONTINUOUS PROPAGATION: 

In its present form, after outputting the range and 
velocity estimates, the Kalman filter program waits for the 
next input sample. During this time period between the output 
and the arrival of the next sample, the system is idle in the 
sense that no data processing is performed. But, at the same 
time, the computer is not free to do any other task unless 
this task is integrated in the filter software. 

This time period can be filled with range data updated by 
way of propagation. Currently, a multiplier and adder circuit 
is being designed at Moffett to perform this task. But, the 
propagation can be done in software rather than in hardware. 

A 

The main program outputs the range and velocity estimates R n 

(or R n+ A as explained above) and V n by passing them to an 

assembly language subroutine which configures a 32 bit data 
out of them and sends it to the output port. After this 

A 

operation, the range R n can be propagated using V n within the 
assembly language subroutine , and then it can be sent to the 
port again. As in the previous case. 



where x is the time it takes to do the above calculation. This 
operation is repeated untill the next sample (or the data 
ready pulse) arrives as follows: 

A /S, A' 

^n+kx = ^n+(k-l)T + ^ » 

where k is the repetition count (see Fig. 3). Note that the 
velocity is assumed to be constant at V n during this period 
of repeated propagation. 

Statistically, the propagated range is the best possible 
estimate at that instant. Since the most recent observation 
(range input) is already utilized to obtain the Kalman filter 

-A -A. , _ . 

estimates R n and V n , and there is no new information 
available, the only way to estimate the range at any 
subsequent instant is by way of propagation [2] . 

The purpose of propagation is only to provide range data 
untill the next measurement arrives, and it does not affect 
the operation of the Kalman filter. When the new sample 
arrives, the filter uses the sample to update the estimate 

R n , not the propagated value. Also, since a linear time 

invariant model is assumed, the sampling interval T has to 
stay constant. If a sample arrives earlier than T seconds, 
the Kalman filter recognizes it as the next input and 
proceeds with the estimation, but this estimate is wrong 
since the calculations are based on constant sampling 
interval assumption. 

The assembly language routines for handling input and 
output have been revised to do the tasks described above. In 
order to avoid too many subroutine calls and minimize the 
execution time, both of them are combined in a single 
assembly language subroutine. A listing is included in the 
appendix. The subroutine parameters are the output data to 
be configured, the range and velocity estimates, and the 



input data. The range and velocity estimates are passed onto 
the I/O subroutine in both real and 32 bit integer formats. 
Integer versions are used for configuring the output data. 
Real numbers are used in the propagation calculations. The 
IBM PC/AT is equipped with a 80287 math co-processor which is 
capable of handling high accuracy real number arithmetic with 
simple instructions in the assembly language level. 

VI. CONCLUSION: 

In this report, we proposed solutions to the problems 
encountered during the initial system tests, namely, 
jittering in the velocity output and the program termination. 
Also, we explained several ideas for improving the system 
performance. These are regarding the input-output time lag 
and more effective utilization of the system by providing 
more range estimates between the input samples. 

As a result of these changes, the software had to be 
revised and a minimal external hardware had to be added. As 
before, either on-site tests or tests at at UCLA with the 
test circuitry are necessary to verify tjfhe functionality of 
the system. 

In the future, more improvements can be made on the 
system. Incorporating an atmospheric refraction correction 
scheme has been on the agenda from the beginning. Once the 
proposed changes in this report are tested, a suitable 
refraction correction algorithm may be integrated into the 
Kalman filtering software. Also, since it is essentially a 
programmable real time data processing system, other 
applications of the system are possible. 
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Fig. 1: Input data configuration 








Fig. 4: System block diagram 
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VERSION II 

THIS IS A TWO STATE KALMAN FILTER FOR LASER RANGE PREDICTION. 

BY TAKING ADVANTAGE OF THE SYSTEM DYNAMICS, MATRIX CALCULATIONS 
ARE ELIMINATED TO MINIMIZE EXECUTION TIME. SOME CONSTANTS THAT 
ARE USED IN THE PROGRAM ARE INITIALIZED AT THE BEGINNING IN ORDER 
TO SAVE CALCULATION TIME IN THE MAIN LOOP. ASSEMBLY LANGUAGE 
ROUTINES ARE USED FOR INPUT/OUTPUT FOR HIGH SPEED. SOME PARAMETERS 
ARE ENTERED INTERACTIVELY BY THE USER. 

DEFINITIONS OF SYMBOLS 

T : SAMPLING INTERVAL 

SCALE , OFFSET : PARAMETERS FOR CONVERTING COUNTS INTO FT 
XPLS1 , XPLS2 : ELEMENTS OF STATE ESTIMATE VECTOR 
: ONE STEP PREDICTION FOR RANGE 
: OBSERVED RANGE (FEET, COUNTS) 

: OBSERVED RANGE AT THE PREVIOUS INSTANT (CNTS) 


XMNS1 
V, IV 
IVO 

IXPLS1, 
IXPLS2 , KOUT 
Pll , P 12 , P22 
HI 1 , H12 , H22 
FF11, 

FF12 , FF22 
GG 

SIGMA 

MINVAR 

MAXVAR 

Z1 

Z2 


INTEGER VARIABLES USED FOR I/O ROUTINE CALLS 
ELEMENTS OF ERROR COVARIANCE MATRIX 
ELEMENTS OF PREDICTION ERROR COVARIANCE 

ELEMENTS OF STATE NOISE COVARIANCE 

OBSERVATION NOISE VARIANCE 

STRAIGHT LINE FLIGHT VARIANCE 

MINIMUM STATE NOISE VARIANCE 

MAXIMUM STATE NOISE VARIANCE 

MAXIMUM INNOVATION AT WHICH MINVAR IS USED 

MINIMUM INNOVATION AT WHICH MAXVAR IS USED 


ASSEMBLY LANGUAGE SUBROUTINES 

INOUT : READS THE 24 BIT DATA FROM THE INPUT PORT 

WHEN THE DATA READY SIGNAL COMES. WHEN THE READY 
SIGNAL IS NOT AVAILABLE, PROPAGATES THE RANGE 
(SECOND ARGUMENT) USING THE VELOCITY (THIRD ARG . ) . 
PROPAGATION LOOP TIME IS PLACED IN THE LAST 
ARGUMENT AND MUST NOT BE CHANGED . 

SENDS THE PROPAGATION TO OUTPUT PORT. READY 
SIGNAL IS CONNECTED TO BIT 24. THE INPUT DATA IS 
PLACED IN THE RETURN ARGUMENT. THE ARGUMENT MUST BE 
DECLARED AS 32 BIT INTEGER (SIXTH ARG) . ALSO, 
CONFIGURES A 32 BIT OUPUT DATA (FIRST ARGUMENT) 

BY COMBINING THE 18 BITS OF THE FOURTH AND 12 BITS 
(MSB=SIGN) OF THE THIRD ARGUMENT. SENDS THE 
CONFIGURED ARGUMENT TO THE OUTPUT PORT. ALL INTEGER 
ARGUMENTS MUST BE DECLARED AS 32 BIT INTEGERS . 

THE SEVENTH ARGUMENT IS ONLY NEEDED IN THE ASSEMBLY 
ROUTINE AND NOTHING MUST BE PASSED TO SUBROUTINE 
IN THIS VARIABLE. 

INDAT2 : READS THE FIRST TWO CONSEQUTIVE SAMPLES FOR 


^ INITIALIZATION DURING START UP, IF REQUESTED. 

C, ***************************************************************** 


o o 
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“USSE^. IVO, IXPLS1, 1»LS2.1COUT,«fc 
REAL MINVAR, MAXVAR, MINVARA, MAXVARA 

TWOTAU=0 . 0002 _ (ft/COUNT) ' 

PRINT* ,' SCALE FACTOR 
READ*, SCALE 

IF (SCALE .LE . 0 . 0) GO TO 1 _ ? (FT) ' 

PRINT*, ' OFFSET 

READ*, OFFSET _ 9f o EC l ' 

PRINT* , ' SAMPLING INTERVAL ’ ^ 

READ* , T 

IF (T.LT. 0.003) THEN uTm^Fr' 

PRINT*, 'SAMPLING INTERVAL MUST BE >- 3 MILLISEC 

GO TO 2 
ELSE 

END IF T7F THE RANGE AND RANGE VELOCITY 

SSS*.;:S Se rapiRS^wo VALID samples pop lmitxalization 7- 

PR TNT * , 9 f 

PRINT*,' O - USE THE FIRST TWO SAMPLES 
PRINT*, '1 - INITIALIZE MANUALLY 

^F^tKTESTl^LT . 0 . OR .KTEST1 . GT . 1) GO TO 3 

IF PRINTS' INITIAL VALUE OF RANGE = ? (FT) 

READ*, XPLS1 

PRINT*^ INITIAL. 0 VALUe'oF^ RANGE VELOCITY = 7 (FT/SEC) ' 

READ* , XPLS2 

IF (ABS(XPLS2) .GT. 1000.0) GO TO 5 
XV- (XP LSI -OFF SET) /SCALE 

T\rn = -1 ' 


100 

101 

102 


ELSE 
END IF 
PRINT*,' ' 

PRINT*, 'THE PARAMETERS ARE : 
PRINT*,' ' 

PRINT 100, SCALE 
FORMAT (IX, 'SCALE FACTOR 
PRINT 101, OFFSET 
FORMAT (IX, 'OFFSET 
PRINT 102, T 

FORMAT ( IX, ' SAMPLING INTERVAL” 

GG=20 .0 

SIGMA=31 . 68 

MINVAR=0 . 005*SIGMA 

MAXVAR” 2 . 0*MINVAR 

Z1=0 . 01*SQRT (SIGMA) 

Z2=100 .0*21 
Pll-10.0 
P12=0 .0 
P22-10.0 
PRINT*,' ' 

PRINT*,' ' 


' , Fll . 3, ' 
' , Fll . 3, ' 
' , Fll . 3, ' 


(FT/COUNT) ' ) 
(FT) ' ) 

(SEC) ' ) 



w 
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w 


w 


p 



103 

104 

105 

106 

107 

108 

109 

6 

110 


9 


10 


11 


PRINT*, '****************** *************************************** 
PRINT*,' ' 

PRINT*,' ' 

PRINT*,' ' m . , 

PRINT*, 'THE NOISE PARAMETERS ARE PRESET AS : 

PRINT*,' ' 

PRINT 103, GG „ r 

FORMAT (IX, 'OBSERVATION NOISE VARIANCE (GG) 

*F11 .3) 

PRINT 10 4, MINVAR , 

FORMAT (IX, 'MINIMUM STATE NOISE VARIANCE (MINVAR) ' 

*F11 .3) 

PRINT 105, MAXVAR , 

FORMAT (IX, 'MAXIMUM STATE NOISE VARIANCE (MAXVAR) ' 

*F11 .3) 

FORMAT (IX, 'MAXIMUM INNOVATION AT WHICH MINVAR IS USED (Zl) - ', 
*F11 . 3) 

FORMAT 1 (IX, 'MINIMUM INNOVATION AT WHICH MAXVAR IS USED (Z2) - ', 

*F1 1.3) 

FORMAT (IX, 'INITIAL VALUE OF ERROR COVARIANCE MATRIX (P) “ 

*F9 . 3, 2X, F9 . 3) 

PRINT 109, P12, P22 
FORMAT (IX,' 

*F9 . 3, 2X, F9 . 3) 

PRINT* r f 

PRINT*" 'DO YOU WANT TO CHANGE THE NOISE PARAMETERS ? 

PRINT*, '0 = NO, 1 = YES 
READ* , KTEST 

IF (KTEST . LT . 0 . OR. KTEST .GT . 1) GO TO 6 

IF (KTEST. EQ.0) GO TO 7 ( 

FORMAT 1 IX, ' --ENTER ANY NEGATIVE VALUE TO LEAVE A PARAMETER', 


*' UNCHANGED — ') 

PRINT*,' ' 

PRINT* ,' OBSERVATION NOISE VARIANCE (GG) 

READ* , GGA 

IF (GGA. LT. 0.0) GO TO 9 
GG-GGA 

PRINT*, 'MINIMUM STATE NOISE VARIANCE (MINVAR) 

READ* , MINVARA 

IF (MINVARA.LT . 0 . 0) GO TO 10 
MINVAR=MINVARA 

PRINT*, 'MAXIMUM STATE NOISE VARIANCE (MAXVAR) 

READ*, MAX VARA 

IF (MAXVARA.LT. 0 . 0) GO TO 11 

MAXVAR=MAXVARA 

IF ( MAXVAR. LE. MINVAR) THEN 

PRINT*, 'MINVAR MUST BE < MAXVAR, ENTER MINVAR AND 

PRINT*,' ' 

GO TO 9 
ELSE 
END IF 


= ? ' 


9 f 


= ? r 


MAXVAR AGAIN r 
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12 


13 


14 


15 


16 


7 


17 


PRINT*, 'MAXIMUM INNOVATION AT WHICH MINVAR IS USED (Zl) 
READ*, Z1A 

IF (Z1A.LT.0.0) GO TO 12 
Z 1 ” Z 1 A 

PRINT*, 'MINIMUM INNOVATION AT WHICH MAXVAR IS USED (Z2) 
READ*, Z2A 

IF (Z2A.LT. 0.0) GO TO 13 
Z2=Z2A 

IF (Z2.LE.Z1) THEN 

PRINT*, ' Z2 MUST BE > Zl, ENTER Zl AND Z2 AGAIN 


PRINT*,' ' 

GO TO 11 
ELSE 

PRINT*, ' INITIAL VALUE OF ERROR COVARIANCE MATRIX :' 
PRINT*, ' P (1, 1) = ? ' 

READ* , P 1 1A 

IF (P11A.LT.0.0) GO TO 14 
P11=P11A 

PRINT*, 'P (1,2)= ? ' 

READ*,P12A 

IF (P12A.LT. 0.0) GO TO 15 
P12=P12A 

PRINT*, ' P (2, 2) = ? ' 

READ* , P22A 

IF (P22A.LT. 0.0) GO TO 16 
P22=P22A 

IF ( (P11*P22-P12**2) .LE . 0 . 0) THEN 

PRINT* , ''ERROR COVARIANCE NOT POSITIVE DEFINITE, 

PRINT*,' ' 

GO TO 13 
ELSE 

END IF , 


ENTER P AGAIN' 


TSQ=T**2 

TSQ2=TSQ/2 . 0 

TCUB=T**3/3 . 0 

TWOT=T*2 . 0 

Q0=MINVAR/TCUB 

Q1=MAXVAR/TCUB 

SLOPE= (Q1-Q0) / (Z2-Z1) 

ZINT=Q0-Z1* SLOPE 

IF (KTEST1 . EQ . 1 ) GO TO 30 

CALL INDAT2 ( IV0 ) 

IF (IV0.LT.0) GO TO 17 
CALL INDAT2 ( IV) 

IF (IV.LT.O) GO TO 17 

IF (ABS (IV-IVO) .GT.20) GO TO 17 

XPLSl=IV*SCALE+OFFSET 

XPL'S2= (IV-IVO) *SCALE/T 

IV0=IV 

GO TO 30 


17 


c MAIN LOOP STARTS 

C UPDATE STATE NOISE COVARIANCE (VARY LINEARLY WITH THE INNOVATION 

50 Z=ABS (XMNS1-V) 

IF (Z.GE.Z2) GO TO 20 
IF (Z.LE.Z1) GO TO 30 
QR=Z*SLOPE+ZINT 
GO TO 40 
20 QR=Q1 

GO TO 40 
30 QR=Q0 

40 FF11=QR*TCUB 

FF12=QR*TSQ2 
FF22=QR*T 
C 

c CALCULATE PREDICTION ERROR COVARIANCE 
Hll=Pll+TWOT*Pl2+P22*TSQ+FFll 
H12=P12+T*P22+FF12 
H22=P22+FF22 


C 

c 


c 

c 

c 


STATE PROPAGATION (PREDICTION) 
XMNS1=XPLS1+T*XPLS2 
E=H11+GG 
Dl=GG/E 
D3=-H12/E 


CONVERT COUNTS INTO FEET, CHECK FOR RUN/STOP, 

CHECK FOR DATA VALID/ INVALID, CHECK ONE STEP DIFFERENCE 
V=IV*SCALE+OFFSET 
IF (V.GT. 260000.0) GO TO 99 
IF (IV.LT.0) GO TO 55 

IF ( IV0 . GE . 0 . AND . ABS ( IV-IV0 ) . GT .20) GO TO 55 


C 

C STATE UPDATE (ESTIMATE) 

XPLS 1=D1 *XMNS 1+H1 1 *V/E 
XPLS2=D3* (XMNS1-V) +XPLS2 


C 

C CALCULATE ERROR COVARIANCE 
P 1 1=D1 *H1 1 
P12=D1*H12 
P22=D3*H12+H22 

C IF OBSERVATION INVALID, USE ONE STEP PREDICTION 

55 XPLS1=XMNS1 
PI 1=H1 1 
P12=H12 
P22=H22 


C 

C 

c 

c 

c 

c 

56 


END THE RANGE AND VELOCITY ESTIMATES TO THE OUTPUT PORT 
EAD THE NEW SAMPLE IF DATA IS READY 

F NOT READY, PROPAGATE THE RANGE ESTIMATE USING VELOCITY EST 
AU IS THE TIME IT TAKES TO PROPAGATE (MULT. BY 2 SINCE VEL IS 
DIVIDED BY 2) 


IV0=IV 

PLS1= (XPLS1+XPLS2* . 002-OFFSET) /SCALE 
IXPLS1=PLS1 

PLS2=XPLS2 / (2 . 0*SCALE) 


IXPLS2=PLS2 

CALL INOUT (KOUT , PLS1 


PLS2, IXPLS1, IXPLS2, IV, IDUMMY, TWOTAU) 


C 

C GO BACK FOR THE NEXT DATA 
GO TO 50 
99 STOP 
END 


,j2 


Z) 
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inout . asm 


FRAMES 

DOUT 

RRANGE 

RVEL 

RANGE 

VEL 

KV 

y 

TOTAU 

FRAMES 

STACK 

STACK 

MYPRO 

INOUT 


PAGE , 132 

TITLE FORTRAN SUBROUTINE 

. 8087 

STRUC 


DATA TO BE SENT TO THE PORT 
LOCATION OF RANGE (SHORT REAL) 

LOCATION OF VELOCITY (SHORT REAL) 

RANGE (32 BIT INTEGER) 

VELOCITY (32 BIT INTEGER) 

INPUT DATA 

VELOCITY IN SIGN/MAG. 16 BIT INT . FORM 
2 ‘PROPAGATION LOOP TIME 


DD ? 

DD ? 

DD ? 

DD ? 

DD ? 

DD ? 

DD ? 

DD ? 

ENDS 

SEGMENT WORD STACK 'STACK' 

DB 64 DUP ('MYSTACK' ) 

ENDS 

SEGMENT 'CODE' 

ASSUME CS: MYPRO, SS: STACK 
PROC FAR 
PUBLIC INOUT 
PUSH AX 
PUSH BX 
PUSH CX 
PUSH DX 
PUSH SP 

CONFIGURE INPUT AND OUTPUT 
MOV DX, 230H 
MOV AL, OFH 
OUT DX, AL 
MOV DX, 228H 
SUB AX, AX 
OUT DX, AL 

STORE VELOCITY IN SIGN MAGNITUDE FORM FOR LATER USE 

; LOAD ADDRESS OF VELOCITY 
; GET SIGNED BYTE OF VEL 


; SAVE THE REGISTERS 


PORTS 

; CONTROL REG OF OUTPUT PORT 

; CONFIGURE OUTPUT PORTS 
; CONTROL REG OF INPUT PORT 

; CONFIGURE INPUT PORTS 


LDS 

SI , ES : VEL [BX] 

MOV 

AL, [SI] +3 

CMP 

AL, 00H 

JNS 

CONFIG 

MOV 

AX, [SI] 

NOT 

AX 

ADD 

AX, 1 

OR 

AX, 8000H 

LDS 

SI , ES : Y [BX] 

MOV 

[SI] , AX 

JMP 

MANIP 

CONFIG: MOV 

AL, [SI] 

LDS 

SI, ES : Y [BX] 

MOV 

[SI] , AL 

LDS 

SI , ES : VEL [BX] 

MOV 

AL, [SI]+1 

AND 

AL, 7FH 

LDS 

SI , ES : Y [BX] 

MOV 

[SI] +1, AL 


. if VEL +VE, GO ON WITH DATA CONFIGURATION 
; ELSE, CONVERT TO SIGN (BIT 15) -MAG (0-14) 


; ADDRESS OF SECOND VELOCITY LOCATION 
; STORE IN FIRST TWO BYTES OF VEL 

; FOR +VE VEL, PUT SIGN IN BIT 15 
; in THE SECOND VELOCITY LOCATION 
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CONFIGURE THE 32 BIT OUTPUT (DOUT) 


SI , ES : RANGE [BX] 
AX, [SI] 

SI , ES : DOUT [ BX] 
[SI] , AX 

SI, ES : RANGE [BX] 
AL, [ S I ] +2 
CL, 2 
AL, CL 

SI,ES :Y[BX] 

AH, [SI] 

AX, CL 

S I , ES : DOUT [BX] 
[SI] +2, AH 
S I , ES : Y [BX] 

AX, [SI] 

CL, 3 
AX, CL 
CL, 4 
AH, CL 
CL, 3 
AX, CL 
AL, 3FH 

SI , ES : DOUT [BX] 
[SI] +3, AL 


LOAD ADDRESS OF RANGE 

GET THE FIRST TWO BYTES OF RANGE 

LOAD ADDRESS OF DATA TO BE SENT OUT 

STORE THE FIRST TWO BYTES OF RANGE IN DOUT 

RANGE ADDRESS AGAIN 

GET THE THIRD BYTE OF RANGE 

ROTATION COUNT 

LOAD THE ADDRESS OF VELOCITY 
GET THE FIRST BYTE OF VELOCITY 
PUT THE CONFIGURED BYTE IN AH 
ADDRESS OF DOUT 

STORE THE THIRD BYTE TO GO OUT 
ADDRESS OF VELOCITY 
GET VELOCITY IN AX 

r CONFIGURE FOURTH BYTE 


1 STORE THE FOURTH BYTE TO GO OUT 


SEND THE DATA TO THE OUTPUT PORTS 


MOV DX, 2 3 1H 
MOV AL, [SI] 

OUT DX, AL 
INC DX 

MOV AL, [SI]+1 
OUT DX, AL 
MOV AL, [SI] +2 
INC DX 
OUT DX, AL 
INC DX 

MOV AL, [SI] +3 
OUT DX, AL 

READ THE DATA READY PULSE 
MOV DX, 2 2CH 
IN AL, DX 
RCR AL, 1 
JC READY 


; POINT TO PORT 0 
; GET THE FIRST BYTE IN AL 
; OUT FIRST BYTE TO PORT 0 
; POINT TO PORT 1 
; GET THE SECOND BYTE IN AL 
; OUT SECOND BYTE TO PORT 1 
; THIRD BYTE IN AL f 

; POINT TO PORT 2 
; OUT THIRD BYTE TO PORT 2 
; POINT TO PORT 3 
; LAST BYTE IN AL 
/LAST BYTE TO PORT 3 

/POINT TO INPUT PORT 3 

/GET THE READY PULSE IN CARRY 
/IF DATA READY, GO READ IT 


IF DATA NOT READY, PROPAGATE THE RANGE 


FINIT 

LDS SI, ES : RVEL [BX] 
FLD DWORD PTR [SI] 
LDS SI , ES : TOTAU [BX] 
FMUL DWORD PTR [SI] 
LDS S I , ES : RRANGE [ BX ] 
FADD DWORD PTR [SI] 
FST DWORD PTR [SI] 
LDS SI, ES: RANGE [BX] 
FISTP DWORD PTR [SI] 
FWAIT 

JMP MANIP 


/INITIALIZE THE CO-PROCESSOR 

/VELOCITY TO TOP OF STACK 

/MULTIPLY BY TIME 

/ADD TO THE RANGE 
/STORE THE REAL VALUE 

/POP AND STORE THE 16 BIT INTEGER VERSION 
/CHECK DATA READY PULSE AGAIN 



IF DATA READY, READ IT FROM THE INPUT PORTS 


READY: 

LDS 

SI, ES :KV[BX] 

; LOCATION OF THE INPUT 


MOV 

DX, 22BH 

; POINT TO PORT 2 


IN 

AL, DX 



AND 

AL, 3FH 



CMP 

AL, 20H 

; IS THERE A STOP REQUEST? 


JNS 

TERM 

; IF STOP REQUESTED, SET UP FOR TERMINATION 


AND 

AL, 1FH 



CMP 

AL, 10H 

; IS THE DATA VALID? 


JS 

PRED 

; IF NOT, GO TO PREDICTOR SET-UP 


AND 

AL, OFH 

; IF VALID, MASK THE VALID/ INVALID BIT 


MOV 

[SI] +2, AL 



DEC 

DX 

; READ THE REST OF THE INPUT 


IN 

AL, DX 



MOV 

[SI] +1, AL 



DEC 

DX 



IN 

AL, DX 



MOV 

[SI] , AL 



MOV 

AL, 0 OH 



MOV 

[SI ] +3, AL 



JMP 

FIN 


; INPUT 

DATA 

CONFIGURATION 

FOR INVALID SAMPLES 

PRED: 

MOV 

AL, OFFH 



MOV 

[SI]+3, AL 



JMP 

FIN 


; INPUT 

DATA 

CONFIGURATION 

FOR STOP REQUESTS 

TERM: 

SUB 

AX, AX 



MOV 

[SI] , AX 



MOV 

AX, 002 OH 



MOV 

[SI] +2, AX 


FIN: 

POP 

SP 

; RESTORE THE REGISTERS 


POP 

DX 



POP 

cx 



POP 

BX 

i 


POP 

AX 



RET 



INOUT 

ENDP 



MYPRO 

ENDS 




END 





inports2 .asm 


FRAME 

NV 

FRAME 

STACK 

STACK 

MYPROG 

INDAT 


REDY : 


PRD: 

FINAL: 


INDAT 

MYPROG 


WORD STACK ' STACK' 
DUP ('MYSTACK' ) 


PAGE , 132 

TITLE FORTRAN SUBROUTINE 

STRUC 

DD ? 

ENDS 
SEGMENT 
DB 64 
ENDS 

SEGMENT 'CODE' 

ASSUME CS : MYPROG, SS : STACK 
PROC FAR 
PUBLIC INDAT 
PUSH AX 
BX 
CX 
DX 
SP 

DX,228H 
AX, AX 
DX, AL 
DX, 4H 
AL, DX 
AL, 1 
REDY 

SI , ES : NV [BX] 

DX 

AL,D\ 

AL, 1FH 
AL, 10H 
PRP 
AL, OFH 
[SI] +2, AL 
DX 

AL, DX 
[SI] +1, AL 
DX 

AL, DX 
[ S I ] , AL 
AL, 0 OH 
[SI] +3, AL 
FINU 
AL, OFFH 
[SI] +3 , AL 
SP 
DX 
CX 
BX 
AX 


PUSH 

PUSH 

PUSH 

PUSH 

MOV 

SUB 

OUT 

ADD 

IN 

RCR 

JNC 

LDS 

DEC 

IN 

AND 

CMP 

JS 

AND 

MOV 

DEC 

IN 

MOV 

DEC 

IN 

MOV 

MOV 

MOV 

JMP 

MOV 

MOV 

POP 

POP 

POP 

POP 

POP ’ 

RET 

ENDP 

ENDS 

END 


* SAVE THE REGISTERS 


POINT TO CONTROL REG 
0 TO AX 

CONFIGURE PORTS FOR INPUT 

POINT TO PORT 3 

READ THE DATA READY BIT 

GET THE READY BIT IN CF FOR CHECKING 

IF DATA NOT READY, CHECK AGAIN 

LOCATION OF THE RANGE 

POINT TO PORT 2 

GET THE MSB OF THE DATA, BITS 16-23 
MASK THE UNUSED BITS (23,22,21) 

IS THE DATA VALID? (AL-10) 

IF NOT VALID, GO TO PREDICTOR SET UP 

IF VALID, MASK THE VALID/ INVALID BIT 

STORE THE THIRD BYTE 

POINT TO PORT 1 

GET THE SECOND BYTE 

STORE THE SECOND BYTE 

POINT TO PORT 0 

GET THE FIRST BYTE 

STORE THE FIRST BYTE 


: COMPLETE TO 32 
r GO TO RETURN 


BIT +VE INTEGER 


,* MAKE KV A NEGATIVE INTEGER 
; RESTORE THE REGISTERS 



